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Abstract : 

In this paper a decentralized trajectory controller for robotic manipulators is designed and 
tested using a multiprocessor architecture and a PUMA 560 robot arm. The controller is made up 
of a nominal model-based component and a correction component based on a variable structure 
suction control approach. The second control component is designed using bounds on the difference 
between the used and actual values of the model parameters. Since the continuous manipulator 
system is digitally controlled along a trajectory, a discretized equivalent model of the manipulator is 
used to derive the controller. The motivation for decentralized control is that the derived algorithms 
can be executed in parallel using a distributed, relatively inexpensive, architecture where each joint 
is assigned a microprocessor. Nonlinear interaction and coupling between joints is treated as a 
disturbance torque that is estimated and compensated for. 

1. Introduction : 

Strategies for designing manipulator controllers can generally be classified according to the 
degree of their dependence on the availability of reasonably accurate manipulator models. While 
some of these schemes, such as those based on systems with variable structure [1-10], model 
referenced [11,12], and self tuning controllers [13,14], are not necessarily model-based, others [15-22] 
depend to a varying extent on the availability of such models. Although controllers that belong to the 
first class are clearly robust to model inaccuracies, such schemes often disregard useful information 
embodied in the dynamic equations. Some of these approaches, however, have recently taken account 
of manipulator dynamics [2,4,5,11,12,22] in the form of additional nonlinear feedback. Model-based 
robot controllers, on the other hand, such as the computed torque control [15], are susceptible to 
deviations of the used model parameters from their actual values. More general nonlinear model- 
based control approaches [16,17] rely on using the complicated Lagrange-Euler inverse dynamic 
equations in real time. As a result, additional model inaccuracies are introduced if and when 
simplified versions of the L-E equations are used. Relatively few studies [17] have investigated the 
robustness of these control schemes to model parameter uncertainty. 

It is generally agreed to in the literature that compensation for model inaccuracies is necessary to 
improve the robustness of model-based controllers. One form of such compensation, among others, 
is the use of the theory of systems of variable structure (VS) to compute auxiliary (or substitute) 
control signals. Many attempts in designing robotic VS controllers have relied on neglecting major 
components of the coupling torques between manipulator joints. Compensation for such torques is 
often left to the VS controller to achieve. The controller performance, however, can be significantly 
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improved if estimates of these torques are also fed forward to compensate for them. While some 
efforts have ignored all components of the coupling torques (gravity as well as inertia and velocity 
coupling torques) and treated them as disturbances that can be compensated for by the VS controller 
[1,3,6,9,10], others have relied on direct computation of gravity torques [5] or have made use of the 
full set of dynamic equations [2 ,4 ,7,8]. The latter approach depends on the complexity of the 
manipulator dynamics and implementation of the control schemes of [2, 4, 7, 8] for manipulators other 
than the used simple two and three link robots is computationally expensive. Most of the developed 
VS manipulator controllers have been tested by simulation using very simple (two or three link) 
robotic structures [1—3,6—10], By contrast, few efforts have been tested experimentally using actual 
robot arms [5], The majority of the reported analyses in this area use continuous time models 
[1,2,4,6-10] and ignore the effects of friction and damping encountered by the joint motors. Since 
the robot system is a continuous one that is digitally controlled along a trajectory (or towards a 
desired position), however, a discretized equivalent (or a sampled data) model of the manipulator is 
most relevant to this problem. 

In this paper, a discretized equivalent model of the continuous robotic system is used at the 
joint level, taking into consideration all dynamic nonlinearities and sampling effects, to develop a 
decentralized linear time-varying controller. The motivation for decentralized control is that the 
developed control algorithms can be executed in parallel using a distributed, relatively inexpensive, 
architecture while avoiding the burden of computing a global nonlinear manipulator model in 
real time. Time schedules of the feedback gains and feedforward terms are computed off-line by 
computing the inverse dynamics along the desired trajectory. Due to uncertainty in some dynamic 
parameters, however, such as link inertial parameters, some coefficients of the discrete model are 
not exactly known. These coefficients also change as the robot configuration and load change. This 
is where the developed controller is modified using a variable structure suction control approach 
to compensate for model inaccuracies. The approach of this paper makes use of the knowledge 
of the model form and some of its poles and zeros. This results in a reduction of the number of 
unknown parameters and more accurate system representation. The developed controller is tested 
using a multiprocessor architecture and a six joint PUMA 560 robot arm. Each joint is assigned a 
microprocessor board based on an Intel 8086 processor. The parallel operation of the six processors 
is synchronized by a common clock. In section 2 of this paper the discrete manipulator model is 
presented along with the model— based controller. The VS— based controller is developed in section 
3. Finally, section 4 presents the experimental testing of the developed controller. 

2. A Discretized Equivalent Model and a Controller for a Manipulator Joint ; 

2.1. The Discretized Equivalent Model : 

The discretized equivalent manipulator model developed in [21] is adopted in this paper since it is 
thought to account for nonlinear arm dynamics, joint motor electrical and mechanical characteristics, 
damping factors, friction, interference torque between joints, and sampling effects. A block diagram 
of this model with possible digital compensation and feedback filters is shown in Figure 1. The 
control voltage, V is output by each microprocessor joint controller to a digital-to-analog converter 
(DAC) which acts as a zero order hold (Z.O.H.) device. The DAC output voltage, V DAC , is applied 
through a linear voltage amplifier to the joint motor input. V a and V m are the armature and motor 
voltages, R a and L a are the armature resistance and inductance, I a is the armature current, Jfc„ is 
the motor voltage constant, r is the torque applied by the motor shaft, r d is the disturbance torque 
observed at the motor shaft which includes inertia and velocity coupling, gravity, friction, and other 
disturbance torques, J is the effective inertia at the motor shaft, B is the effective damping factor, 
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n is the gear ratio, k' is a conversion constant, 9 a and 8 d are the actual and desired joint positions, 
and r' d is a feedforward compensation for r d . The system inside the dashed line is continuous while 
the one outside is described by the digital hardware and software used to control the joint. 



Figure 1. A Discretized Equivalent Joint Model 


Assuming that J can be approximated by a constant within each sampling interval, the following 
transfer functions are obtained [21] 
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where the inertia J, and disturbance torque r di encountered by the rotor of joint i, are 
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where Du and r, are the self inertia and torque of joint i computed using the inverse dynamic 
equations [15,22], J r> , r Jit and n, are the rotor inertia, friction torque, and gear ratio of joint i. 
Using an exact mapping of poles and zeros from the s plane into the z plane, (z = e ’ T , where T is 
the sampling period), the discretized equivalents of the transfer functions (1) are [21] 
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where the gains Jfc// and kp> are computed such that the steady state discrete system response is 

equal to the sampled steady state continuous system response. 
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2.2. The Digital Linear Time-Varying Controller : 

Given the transfer functions (3) that represent a manipulator joint, the control task is to design 
the digital filters F(z), D(z), G(z), and a dynamics-based feedforward control signal such that 6 a 
tracks 9d as closely as possible. To perform this task it is necessary here to note the timing of 
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the model operation. At sample point n a desired position 0<*(n) and an estimated feedforward 
term r^(n) that compensates for r d are input to the system while the actual joint position 0 a (n) i® 
observed. It is desired that the actual position at the next sample time (n+1) be equal to the desired 
position input to the system at the current sample time i.e. 0 a (n + 1) = 0 d (n). To achieve this it is 
necessary to estimate a discrete input, rj(n), that is equivalent to T d ahead of time to compensate 
for r d between the two sample times. This feedforward compensation signal is computed off-line 
using the robot inverse dynamic equations. Hence, it is desired first to have T d (z) = z~ 1 r^ i (z). As a 
result, one gets [21] 


T d( Z ) F '( Z ) k F' 

After simple manipulations, the filters D(z) and G(z) that result in the response 0 a (z) = z -1 
are found to be [21] 
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The feedback control is then written as 

v(«) = fl(«)r(.)[M*)-*.WI + rW<lW with g(.)z(.) = i- 1 V i ;~‘ (s) 
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In the discrete time domain, the controller is written as 

V { («) = ^(A*(n) - P?(")A*(n - 1)] + *rft“(n) + C(» - 1)] -V(n- 1) (6.a) 


where A0(n) = 6 d (n) - 0 a (n) (6.6) 

and superscript u denotes used (as opposed to actual) values. It remains, however, to compute the 
feedback gains fc£(n), (n), and rj u (n). Since the only information available to a joint controller 

in a decentralized control environment is that generated off-line, estimates of these parameters are 
computed off-line, when the desired trajectory is generated, and later used in real time to implement 
the controller (6). This scheme is based on a computed torque approach and, as a result, is susceptible 
to the potential problems facing a computed torque approach. The most serious problem of these is 
the difference between the values of J and r d along the actual path and their nominal (used) values 
along the desired path. To address this problem, the controller (6) is modified using the theory of 
systems of variable structure (VS) to compensate for parameter uncertainty. The modified controller 
is developed in the next section. 


3. Development of The Variable Structure Controller : 

The purpose of the VS-based controller introduced in this section is to modify the controller 
(6) such that deviations of the used model parameters from their actual values are compensated for. 
The basic form of the controller (6) is, however, maintained since it is based on the actual model 
form which is known. An appropriate sliding surface and a switching variable are selected in terms 
of the joint tracking error and a suction control strategy [2,4] is used in the discrete time domain to 
design the controller such that the switching variable and tracking error converge to zero. First, the 
model (3) is written in the discrete time domain in terms of the actual model parameter values as 

M n ) =M n_ 1) + Pi (n - l)[0 a (n- l)-0 o (n-2)] 

+ *»(»- l)|V(n - 1) + V(n - 2)1 - *" ( "~ 1) M(n - 1) + rj(n - 2)) (7) 
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and the switching surface for each joint i is defined as 

s(n) = e(n) + Ae(n - 1) , c(n) = 0 d (n - 1) - 0 a (n) (8) 
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such that the trajectory tracking error decays exponentially when the switching variable is driven to 
zero. The switching variable s is "sucked” to zero using a discretized version of the suction control 
strategy outlined in the continuous time domain in [2,4]. Namely, the controller is designed so that 

s(n - 1) [a(n) - s(n - 1)] < 0 (9) 

such that s(n) > s(n - 1) if s(n - 1) < 0 and s(n) < s(n - 1) if s(n - 1) > 0. Condition (9) is 
not sufficient for the convergence of s(n) to zero. If |s(n) - s(n - 1)| can, however, be shown to be 
bounded by a small positive number 8 then s(n) can also be easily shown to be bounded by a small 
positive number 8' using condition (9). To show this, we write 

|s(n) — s(n - 1)| =| e(n) — e(n — 1) + A[e(n — 1) — c[n — 2)]| 

=|*„(» - 1) - 0 d [n - 2) - [*«(") - 9 a (n - 1)] 

+ \{9 d (n - 2) - 9 d (n - 3) - [*.(» - 1) - 9 a {n - 2)]}| 

<|M» - 1) - 0 d {n - 2)| + |M") - 9 a {n - 1)| 

+ |A|[|Mn " 2) - 0 4 {n - 3)| + |M" - 1) - 9 a {n - 2)|] 

<6l + 62 + |A |(«3 "t" 64) < 9 

where the magnitude of the upper bound 6 is determined by the speed of the desired trajectory, 
the manipulator mechanical time constants, and the sampling frequency. It is clear that 8 decreases 
with increasing sampling frequency. For example, if the desired and actual joint speeds are bounded 
by 10 rad/s and the sampling frequency is 100 Hz, then |s(n) — *(« — 1)1 i s bounded by 0.25 radians 
for A = 0.25. It is clear that as the sampling frequency increases infinitely, condition 10 tends to the 
suction control condition ss < 0 of [4]. Although the condition 

s(n) [s(n) - »(n - 1)] < 0 (9)' 

is more attractive since it ensures that 0 > s(n) > s(n — 1) if «(n — 1) < 0 and 0 < s(n) < s(n — l) 
if s(n - 1) > 0, the design of a controller that would satisfy condition (9)’ is quite complicated 
mathematically (as will be clear from the proof of Lemma 1.). Next, we proceed to design a 
controller that satisfies condition (9). First, the following set of upper bounds on model parameter 
deviations is defined 

a > > I , a > 1 , fl>\ p?(n) - pi(n)| , 7 > I CN ~ r' d (n) | , n > 0 (10) 

k H (n) a 

The variable structure controller that satisfies condition (9) is given by the following lemma. 


Lemma 1 : The control 
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Satisfies the convergence condition (9). 

Proof : Using the controller (11), the closed loop system response (7) is rewritten as 
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Using equation (12) and defining the following quantities, 

f( n ) = » PiH = Pi(”) ~ P?( n ) . ?'(n) = T d( n ) ~ C( n ) (13) 

the increase in the value of the switching variable s between sample times n-1 and n is 
s(n) - s(n — 1) =e(n) - (1 - A)e(n - 1) - Ae(n - 2) 

=^(n - 1) - 0 a (n) - (1 - A)e(n - 1) - Ae(n - 2) 

= (l - ^ ( ”~ / ‘ ) ) M" - 1) - (1 - A)e(» - 1) - M- - 2)1 

- [‘ - +->.(»-!)- - d] ».<■ - 1) 

+ Pi(n - 1) - ~ !) *•(»-*) 

-af(n-l) ~~y~|ti,(n — 1)| + /9|0 a (n - 1) - 0 a (n - 2)| sgn s(n - 1) 


Mn - 1) 


r d (n “ !) + ? d( n ~ 2 ) ~ 2 7 sgn s(n - 1)] 


= (i - Ul ( n ~ !) ~Pi(«- !)[•«("- !) - M n 


- - 1 ) 


a - 1/a 


>v 7 la + 1/a 
( n - 1) , t . 


|uj(n - 1)| + P\ 0 a (n - 1) - 0 a (n - 2)| sgn s(n - 1) 


+ 7j L [T' d {n - 1 ) + fd(n - 2) - 27 sgn s(n - 1 )] 

k f 

= (* - a + 1/tt ) Ul (" -1 ) _ a f( n - D^K(» - !)l a 9 n *(" - !) 

-pi(n - l)[0„(n - 1) - 0„(n - 2)] 

- af(n - l)(}\O a (n - 1) - 0 a (n - 2)| sgn s(n - 1) 

+ — ~[ ? d( n “ !) + f d( n “ 2 ) - 2 7 sgn s(n - 1)] (14) 

k f 

Hence, 
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=a(n)|u 1 (n - l)s(n - 1)| + 6(n)|s(n - l)[0 o ( n - 1) - M n “ 2 )]| + c(n)|s(n - l)| (15) 

and k (n), n > 0, will be shown to be negative by showing that a(n), 6(n), and c(n), are negative. 
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1. To show that o(n) is negative, we need to show that 

|o + 1/a - 2f(n - 1)| < |af(n - l)(a - l/a)| 

Since the right hand side of inequality (16) is positive, two cases are at hand 

a) If a + 1/a - 2f(n - 1) > 0, then we need to show that 

a + 1/a - 2? (n - 1) <a 2 f(n - 1) - f (n - 1) 
or 1/a - ?(n - 1) <a[af (n - 1) - 1] 

or 1 - af(n - 1) <a 2 [af(n - 1) - 1] 

This inequality is satisfied since a 2 > ±1. Hence, a(n) is negative. 

b) If a + 1/a - 2 f(n - 1) < 0, then we need to show that 

2f(n - 1) - a - 1/a <a 2 f(n - 1) - ?(n - 1) 
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since 

a 4 + a 2 - 3a 2 + 1 =(a 2 - l) 2 > 0 


Hence, a(n) is negative. 

2. To show that 6(n) is negative, we need to show that 

|Pi(« “ !)l < a f( n ~ i)/ 3 

This inequality is satisfied since |pj(n — 1)| < ft and af(n — 1) > 1 by definitions (10). 

3. c(n), n > 0, is negative since |?j(n)| < 7 by definition (10). 

Hence, it is seen that fc(n) < 0, n > 0, and condition (9) is satisfied. 

Q.E.D. 

The next section presents the experimental testing of the developed controller. 

4. An Example ; A PUMA 560 Manipulator : 

To obtain model parameters for a PUMA 560 arm, the motor and armature circuit parameters 
k v , J r , and L a , were obtained from the manufacturer. R a was measured for each joint by applying 
a DC voltage at the DAC output and measuring the armature current when no motion took place. 
To obtain the damping factor and friction torque for each joint a DC voltage was applied at the 
DAC output and the armature current and joint speed were measured. The resulting data points 
of current versus speed yielded fJ t - and Tj i using regression techniques. The linear voltage amplifier 
gain was set to 4. It was also necessary to adopt a set of link dynamic parameters. There are few 
reported efforts directed at identifying parameters not supplied by manufacturers such as inertial 
parameters and centroid coordinates. While some of these efforts adopt direct geometric approaches 
[22], others rely on experimental identification of these parameters [23-25]. Many approximations 
are made in [22] about link mass distribution and component shapes. Identification techniques 
require acceleration, torque, and force sensors and the results often bear a lot of noise [24], In this 
paper, link masses were obtained from the manufacturer. Most of the centroid coordinates and 
inertial parameters reported in [22] were thought to be reasonably accurate and were used. All of 
the used model parameters for the used PUMA 560 arm are listed in [21]. a, ft, and X were set to 
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2, 0.2, and 0.25 respectively for all joints. 7 was set to 0.5 N.m for the first three joints and 0.05 
N.m for the last three joints. 

The desired trajectory for the arm was specified by a cartesian path and a desired velocity 
profile for the end-effector. The path, sampled every 30 ms, consisted of three curves defined in the 
arm base frame. The first curve was a semicircle that started at (x,y,z)=(15,75,10)cm and ended 
at (5,65,-10)cm. The point (x,y,z)=(10,50,0)cm was in the motion plane and the semicircle followed 
was the one closer to this point. The end-effector accelerated from rest to a velocity of 0.35 m/s 
in the first 3 segments (90 ms), cruised at this speed for 34 segments, and decelerated to rest in 
the last 3 segments. The hand approach vector, a, was required to change from (0,0.9798,-0.2) to 
(0,0.9798,0.2) by requiring the angle 


<j> — tan 1 


o* 



to change from -11.5° to 11.5° by accelerating in the first 3 segments, cruising at a constant speed 
in the middle 34 segments, and decelerating to rest in the last 3 segments. The second curve was a 
straight line that ended at (x,y,z)=(-5,85,-15)cm. The approach vector, a, changed to (0,0.9539,0.3). 
All velocity profiles were similar to those of the first curve except for the numbers of acceleration, 
constant speed, and deceleration segments which were 9, 7, and 9 respectively, and the end-effector 
constant speed which was 0.48 m/s. The third curve was a semicircle that ended at the initial arm 
configuration of the first curve. The point (x,y,z)=(5,60,-2.5)cm was in the motion plane and the 
semicircle followed was the one closer to this point. All velocity profiles were similar to those of the 
first curve except for the numbers of acceleration, constant speed, and deceleration segments which 
were 5, 45, and 5 respectively. The arm stayed at rest for 5 segments between each two curves. The 
corresponding desired joint trajectories are shown in Figure 2. The used PUMA arm was driven 
very close to its maximum speed. 


Last Semicircle 



h 1 1 1 — * — 1 1 1 1 1 1 1 r 

10 20 30 40 50 60 70 80 90 100 110 120 130 

Time (x 30 ms) 



Figure 2. Desired Joint Trajectories 

The arm was sampled every 10 ms and desired joint positions were generated every 10 ms by 
linear interpolation between their values stored for use every 30 ms. The feedback gains computed 
off-line were used three times within the 30 ms intervals each 10 ms (i.e. T— 0.01 sec). The 
computation delay at each sampling interval was 1.00 ms. The joint trajectory tracking errors 
resulting from this experiment are shown in Figure 3. The tracking error is bounded by 2 degrees 
for joints 1 and 2, 4 degrees for joint 3, 0.5 degrees for joint 4, 1.5 degrees for joint 5, and 0.25 degrees 
for joint 6. This performance is slightly worse than that of the controller of [21] which is similar to the 
controller of this paper except for the absence of the VS-based compensation for model inaccuracy. 
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One probable cause for the increase in the tracking error, compared to the results of [21], is the 
chattering problem associated with the VS-based control. This chattering effect is clear in the high 
frequency behavior of the tracking error of Figure 3 and was felt clearly when the used manipulator 
exhibited noisy gittery motions during the performed experiments. Another probable cause for the 
increase in the tracking error is the increase in the computation delay (which is 0.55 ms for the 
controller of [21]). It does not appear that using a VS-based control, in the experimental context 
and setup described in this paper, to compensate for model parameter uncertainty has offered an 
advantage over using parameter estimates computed off-line. 



Figure 3. Joint Tracking Errors 
5. Conclusion : 

A decentralized digital linear time-varying variable structure trajectory controller for manipu- 
lator arms was developed and tested. A discretized equivalent model of the continuous manipulator 
system was used to design a nominal digital linear time-varying feedback. Time schedules of the 
estimated values of the feedback gains and feedforward terms were generated off-line. The feedback 
was modified using the theory of systems with variable structure to compensate for the difference 
between the used and actual values of the model parameters. The controller performs reasonably 
well considering that the used PUMA arm was driven along the trajectory at its maximum speed. 
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